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Abstract of EP1172183 

A device for ascertaining and calculating the corrected movement data for a 
specified sequence of movements of a movable device or tooling, has an image 
detection device, such as a digital camera (11) and a computer unit. The 
computer unit determines the corrected movement data via a reference device 
(9) according to controlle lOOf d movement of the movable device. The reference 
device (9) shows unambiguous aspects of the image in a specified solid angle 
range, while the computer unit calculates a transformation specification for 
correction of the original movement data, from an actual image of the reference 
device (9) recorded by the image detection unit (1 1 ). 
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(54) Vorrichitung und Anordnung zur Ermittlung von l<orrigierten Bewegungsdaten fur einen 
vorgegebenen Bewegungsabiauf einer bewegbaren Einrichtung sowie bewegbare 
Einriciitung und System aus bewegbaren Einrichtungen 



(57) EswirdeineVorrichtung zur Ermittlung von kor- 
rigierten Bewegungsdaten fur einen Bewegungsabiauf 
einer bewegbaren Einrichtung (5) nach einer von der 
Steuerung der bewegbaren Einrichtung (5) nichtausrei- 
chend erfassten Bewegung der bewegbaren Einrich- 
tung (5) vorgeschlagen. Der Erfindung liegt die Aufgabe 
zugrunde, die Ernnittlung von korrigierten Bewegungs- 
daten fur einen Bewegungsabiauf einer bewegbaren 
Einrichtung vergleichsweise genauer und kostengunsti- 
ger vornehmen zu konnen. Zur Losung der Aufgabe um- 
fasst die Vorrichtung eine Bilderfassungseinheit (11) 
und eine Rechnereinheit, wobei die Rechnereinheit 
nach einer von der Steuerung der bewegbaren Einrich- 
tung nicht Oder nicht ausreichend erfassten Bewegung 
korrigierte Bewegungsdaten mit Hilfe von Bezugsmit- 
teln (9) bestinnnnt, die wenigstens in einenn vorgegebe- 
nen Raunnwinkelbereich eindeutig zuordenbare Bildan- 
sichten aufweisen, indenn die Rechnereinheit aus Daten 
von einenn durch die Bilderfassungseinheit (11) aufge- 
nonnnnenen Ist-Bild der Bezugsnnittel (9) nach der nicht 
Oder unzureichend erfassten Bewegung und Daten ei- 
nes Bezugsbildes der Bezugsnnittel (9), bei denn die be- 
wegbare Einrichtung eine eingelernte Bewegung ent- 
sprechend von in der Rechnereinheit abgelegten Urbe- 
wegungsdaten ausfuhren wurde, eine Transformations- 
vorschrift zur Korrektur der Urbewegungsdaten errech- 
net. Des Weiteren wird eine Anordnung zur Ernnittlung 
von korrigierten Bewegungsdaten fur einen Bewe- 
gungsabiauf einer bewegbaren Einrichtung mit Bezugs- 
mittel (9) sowie ein System aus mehreren bewegbaren 
Einrichtungen vorgeschlagen. 




Q. 
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Beschreibung 

[0001] Die Erfindung betrifft eine Vorrichtung zur Er- 
mittlung von korrigierten Bewegungsdaten fur einen 
vorgegebenen Bewegungsablauf einer bewegbaren 5 
Einrichtung, z. B. eines verfahrbaren Roboters, eines Li- 
nearachsensystems usw., nach einer von einer Steue- 
rung der bewegbaren Einriclitung niclit oder nicht aus- 
reicliend erfassten Bewegung der bewegbaren Einrich- 
tung, eine Anordnung, die eine solclne Vorrichtung unn- 10 
fasst sowie eine bewegbare Einrichtung nach denn 
Oberbegriff des Anspruchs 1 und ein Systenn aus nneh- 
reren bewegbaren Einrichtungen. 

Stand der Tech nil< is 

[0002] Die deutsche Patentschrift DE 32 46 828 C2 

offenbart eine nnobile Transport- und Handhabungsein- 
richtung, die aus einenn autonnatisch steuerbaren, lini- 
engebundenen und inn Bereich von Haltestationen grob 20 
positionierbaren Flurforderfahrzeug sowie einenn nnit 
dem Flurforderfahrzeug fest verbundenen Industriero- 
boter besteht, der durch einen Rechner gesteuert wird, 
Inn Weiteren ist eine Messanordnung vorgesehen, de- 
ren Komponenten zunn Tell an der Einrichtung und zunn 25 
Teil ortsfest inn Bereich der Haltestationen angebracht 
sind und durch welche nach der Positionierung der Ein- 
richtung an der Halteposition die Abweichung der Ist- 
Position des Flurforderfahrzeugs von der Soil-Position 
ermittelbar ist. Mittels des Rechners erfolgt eine der Ab- 30 
weichung des Ist-Wertes vom Soll-Wert entsprechende 
Transformation der Handhabungskoordinaten in der 
Robotersteuerung. 

[0003] Fur die Ausgestaltung der Messanordnung 
sind eine Reihe von Ausfuhrungsvarianten in der DE 32 35 
46 828 C2 beschrieben. Beispielsweise weist die IVIes- 
sanordnung einen Taster nnit einem Taststift auf, der am 
Greifer des Roboters angebracht und von diesem auto- 
matisch an ortsfeste Referenzpunkte oder Flachen her- 
anfuhrbar ist. Durch das Antasten dieser Punkte oder 40 
der Flachen kann die Ist-Position der Einrichtung ermit- 
teltwerden. Des Weiteren wird als Messanordnung ein 
Lichtsender, der einen gebundelten Lichtstrahl schrag 
auf eine reflektierende Messflache sendet sowie ein 
Lichtempfanger zur Auf nahme des reflektierten Strahls 45 
vorgeschlagen, wobei aus dem Auftreffpunkt des 
Strahls im Empfanger die Ist-Entfernung ermittelbar ist. 
[0004] Die vollstandig mechanische Bestimmung der 
Ist-Position mittels des Greifers hat den Nachteil, dass 
die Position nurso genau bestimmt werden kann, wie so 
es die Wiederholgenauigkeit der Mechanik zulasst. 
[0005] Die optische Bestimmung der Ist-Position 
durch einen Lichtsender ist insofern nachteilig, als dass 
fur eine dreidimensionale Erfassung der Position drei 
Messungen mit jeweils unterschiedlich position iertem 55 
Sender notwendig sind, worunter wiederum die Genau- 
igkeit der Positionserfassung aufgrund einer begrenz- 
ten mechanischen Wiederholgenauigkeit leidet. 



Aufgabe und Vorteile der Erfindung 

[0006] Der Erfindung liegt die Aufgabe zugrunde, die 
Ermittlung von korrigierten Bewegungsdaten fiir einen 

Bewegungsablauf einer bewegbaren Einrichtung ver- 
gleichsweise genauer und kostengunstiger vornehmen 
zu konnen. 

[0007] Diese Aufgabe wird durch die Merkmale des 

Anspruchs 1 , 6, 10 und 13 gelost. 

[0008] In den Unteranspruchen sind vorteilhafte und 

zweckmaBige Weiterbildungen der Erfindung angege- 

ben. 

[0009] Die Erfindung geht zunachst von einer Vorrich- 
tung zur Ermittlung von korrigierten Bewegungsdaten 
fiir einen vorgegebenen Bewegungsablauf einer be- 
wegbaren Einrichtung, z.B. Elementen eines verfahrba- 
ren Roboters oder eines Systems, bestehend aus meh- 
reren Linearachsen, nach einer von der Steuerung der 
bewegbaren Einrichtung nicht oder nicht ausreichend 
erfassten Bewegung der bewegbaren Einrichtung aus. 
Der Kemgedanke der Erfindung liegt nun darin, dass ei- 
ne Bilderfassungseinheit und eine Rechnereinheit vor- 
gesehen sind und die Rechnereinheit nach einer von 
der Steuerung der bewegbaren Einrichtung nicht oder 
nicht ausreichend erfassten Bewegung die korrigierten 
Bewegungsdaten mit Hilfe von Bezugsmittein bestimmt, 
die wenigstens in einem vorgegebenen Raumwinkelbe- 
reich eindeutig zuordenbare Bildansichten aufweisen, 
indem die Rechnereinheit aus Daten von einem durch 
die Bilderfassungseinheit aufgenommenen Ist-Bild der 
Bezugsmittel im positionierten Zustand derbewegbaren 
Einrichtung nach der nicht oder unzureichend erfassten 
Bewegung und Daten eines Bezugsbildes der Bezugs- 
mittel, bei dem die bewegbare Einrichtung eine ge- 
wunschte Bewegung entsprechend von in der Rechne- 
reinheit abgelegten Urbewegungsdaten ausfiihren wur- 
de, eine Transformationsvorschrift zur Korrektur der Ur- 
bewegungsdaten errechnet. Durch diese Vorgehens- 
weise ist es moglich, durch eine einzige Bildaufnahme, 
die nicht oder nicht ausreichend erfasste raumliche Po- 
sitionsanderung einer bewegbaren Einrichtung an einer 
Messstelle exakt zu bestimmen. Fiir diese Messstelle, 
die einer grob angefahrenen Position entspricht, sind 
die diesbezijglich ermittelten Korrekturdaten fur alle Ur- 
bewegungsdaten maBgeblich. D.h., die bewegbare Ein- 
richtung kann an der Messstelle mit Urbewegungsdaten 
gewunschte Bewegungen durchfuhren, die lediglich 
einmal mit einer Transformationsvorschrift korrigiert 
werden mussen. Die in der DE 32 46 828 beschriebene 
optische Methode bedarf der Vermessung von minde- 
stens drei verschiedenen Messstellen, wodurch das 
Messergebnis von der Wiederholgenauigkeit des me- 
chanischen Systems zum Anfahren dieser Messstellen 
nachteilig beeinflusst wird. Die erfindungsgemaBen 
MaBnahmen haben dariiber hinaus den weiteren Vor- 
teil, dass sie sich in einer vergleichsweise deutlich kom- 
pakteren Bauform realisieren lassen. Des Weiteren er- 
moglicht diese Art der Bewegungsdaten korrektur mit- 
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tels einer Bilderfassungseinheit den Einsatz derselben 
Bilderfassungseinheit und derselben Rechnereinheit 
zur Objekterkennung, wenn die Vorrichtung beispiels- 
weise an einem Roboter angeordnet ist, der z. B. vor- 
gegebene Objekte greifen oder bearbeiten soli. 
[0010] Wird die erfindungsgennaBe Vorrichtung zur 
Bestimnnung der raumliclien Position beispielsweise an 
einem verfahrbaren Roboter mit einem falirerlosen 
Transportfahrzeug und einem am Transportfalirzeug 
angebrachten Manipulator angeordnet, kann dieser Ro- 
boter nacli einer Grobpositionierung, z. B. iiber ein in- 
duktives Leitsystem, eingelernte Bewegungsablaufe 
mit korrigierten Bewegungsdaten an der grob positio- 
nierten Stelle (Messstelle) dennoch exakt durclifuliren 
und zugleicli mit Hilfe der Bilderfassungseinlieit, z. B. 
zu bearbeitende Werkstucke, identifizieren und gege- 
benenfalls in ihrer Lage erkennen. D.li., im Fall eines 
verfahrbaren Roboters mit Manipulator handelt es sich 
um eine bewegbare Einrichtung, namlich den Manipu- 
lator, die selbst nochmals bewegbar bzw. verfahrbar ist, 
denn der Manipulator ist auf einem Transportfahrzeug 
montiert. Insbesondere in einer solchen Ausgestaltung 
ist die Erfindung vorteilhaft, da das Transportfahrzeug 
durch robuste, schnell arbeitende Positioniermittel, die 
vergleichsweise ungenau sein durfen, an einen Einsatz- 
ort gebracht werden kann, wobei dann eine vergleichs- 
weise hohe Genauigkeit der Bewegung des Manipula- 
tors durch die Anpassung der iJrbewegungsdaten des 
Manipulators auf den Einsatzort iiber die erfindungsge- 
ma3e Korrektur erreicht wird. Das Transportfahrzeug 
bleibt dabei unverandert in der grob angefahrenen Ein- 
satzposition (Messstelle). Um eine bestmogliche Kor- 
rektur der Bewegungsbahn eines am Manipulator ange- 
ordneten Werkzeugs ohne mechanische Einflusse zu 
erhalten, wird vorgeschlagen, die Bilderfassungseinheit 
Oder die Bezugsmittel direkt am Werkzeug zu positio- 
nieren. 

[0011] Zur Realisierung eines vergleichsweise ko- 

stengunstigen Aufbaus kann die Bilderfassungseinheit 
eine Videokamera, insbesondere eine digitale Videoka- 
mera umfassen . Es kann jedoch auch eine analoge oder 
digitale Kamera eingesetzt werden. 
[0012] Als Rechnereinheit kann ein handelsiiblicher 
PC eingesetzt werden. 

[0013] Insbesondere beim Einsatz einer digitalen Vi- 
deokamera ist es bevorzugt, wenn die Rechnereinheit 
dazu ausgelegt ist, die Transformationsvorschrift zur 
Korrektur der Bewegungsdaten durch einen Pixelver- 
gleich des Ist-Bildes mit dem Bezugsbild zu bestimmen, 
Mit Hilfe der Transformationsvorschrift kann dann z. B. 
ein Roboterarm, ausgehend von Ursprungsbewe- 
gungsdaten, auch nach einer von einer Steuerung des 
Roboters nicht erfassten Bewegung des Roboterarms 
anhand von korrigierten Bewegungsdaten dennoch in 
exakter Weise vorgegebene Bewegungsablaufe durch- 
fiihren. 

[0014] Vorzugsweise ist die Rechnereinheit zur Er- 
mittlung einer Transformationsvorschrift in Form eines 



Verschiebungsvektors in einem dreidimensionalen Ko- 
o rd in ate n system sowie von Winkeldrehungen um die 
drei Koordinatenachsen ausgelegt, die das Koordina- 
tensystem aufspannen. Durch den Verschiebungsvek- 

5 tor und jeweiligen Drehwinkel lasst sich die Bewegung 
einer bewegbaren Einrichtung im Raum in Bezug auf 
Ursprungsbewegungsdaten mit GroBen korrigieren, die 
insbesondere im Zusammenhang mit einem Roboter, z. 
B. einem 6-Achs-Knickarm roboter, furdessen Ansteue- 

10 rung leicht weiterverarbeitbar sind. 

[0015] Die in einer Anordnung zur Ermittlung von kor- 
rigierten Bewegungsdaten fur einen Bewegungsablauf 
einer bewegbaren Einrichtung nach einer von der 
Steuerung der bewegbaren Einrichtung nicht oder nicht 

15 ausreichend erfassten Bewegung notwendigen Be- 
zugsmittel konnen z. B. ein dreidimensionales Objekt 
mit Orientierungselementen, z. B. Objektkanten oder 
zusatzlich angebrachte Markierungselementen, umfas- 
sen. Als Bezugsmittel ist aufSerdem das virtuelle Bild ei- 

20 nes solchen dreidimensionalen Objekts moglich, insbe- 
sondere in Form eines Hologramms. Bel den Bezugs- 
mitteln kommt es entscheidend darauf an , dass in einem 
vorgegebenen Raumwinkelbereich eindeutig zuorden- 
bare Bildansichten von einer Bilderfassungseinheit auf- 

25 genommen werden konnen. 

[0016] In einer bevorzugten Ausfuhrungsform ist die 
Bilderfassungseinheit an der bewegbaren Einrichtung 
angeordnet, wogegen die Bezugsmittel getrennt von 
der bewegbaren Einrichtung positioniert sind. 

30 [0017] Die Zuordnung von Bilderfassungseinheit und 
Bezugsmittel kann jedoch auch vertauscht werden, In 
diesem Fall sind an der bewegbaren Einrichtung die Be- 
zugsmittel angebracht, wogegen die Bilderfassungsein- 
heit getrennt von der bewegbaren Einheit angeordnet 

35 ist. 

[0018] Fiir den Fall, dass die Bilderfassungseinheit 
getrennt von der bewegbaren Einrichtung positioniert 
ist, muss gewahrleistet werden, dass die Bilddaten ei- 
nen gegebenenfalls an der bewegbaren Einrichtung 

40 vorgesehenen Steuerrechner immer sicher erreichen. 
[0019] In beiden Fallen konnen sowohl die Bilderfas- 
sungseinheit als auch die Bezugsmittel bewegbar an ei- 
ner Aufnahme angeordnet werden. Dies setzt jedoch 
voraus, dass die Position bei einer raumlichen Positi- 

45 onsanderung der Bezugsmittel oder der Bilderfas- 
sungseinheit bei der Berechnung einer Transformati- 
onsvorschrift fiir Bewegungsdaten der bewegbaren Ein- 
richtung mit berucksichtigt werden. 
[0020] Bei der Anbringung der oben beschriebenen 

50 Vorrichtung zur Ermittlung von korrigierten Bewegungs- 
daten an einer bewegbaren Einrichtung, insbesondere 
an einem fahrbaren Roboter mit einem fahrerlosen 
Transportfahrzeug und einem am Transportfahrzeug 
angebrachten Manipulator kann das Bilderfassungssy- 

55 stem entweder am fahrerlosen Transportfahrzeug, am 
Manipulator Oder an einem am Manipulator angeorclne- 
ten Werkzeug angebracht werden. Die Anbringung der 
Bilderfassungseinheit am Manipulator ist dann vorteil- 
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haft, wenn nur ein verfahrbarer Roboter eine oder meh- 
rere Haltestationen zu bedienen hat. In diesem Fall 
kann die Bilderfassungseinheit auch am Transportfahr- 
zeug selber angebracht werden, wobei sich der Mani- 
pulator dann nur inn Rahnnen seiner Wiederholgenauig- 
keit positionieren lasst. 

[0021] Werden jedoch nnehrere verfahrbare Roboter 
eingesetzt, die alle auf eine Reihe von Werkzeuge (z. 
B. Greifer oder Bearbeitungswerkzeuge) zugreifen sol- 
len, ist es inn Weiteren bevorzugt, wenn die Bilderfas- 
sungsnnittel unnnittelbar am Werkzeug, insbesondere 
als zusatzliche Bilderfassungsmittel angebracht sind. 
Durch diese MaBnahme wird die Genauigkeit von Ar- 
beitsgangen nicht durch eine begrenzte Wiederholge- 
nauigkeit des mechanischen Systems des Manipulators 
Oder dadurch beeintrachtigt, dass das selbe Werkzeug 
an verschiedenen Robotern in gegebenenfalls leicht un- 
terschiedlich ausgestalteten Aufnahmen angebracht ist, 
[0022] An den Positionen, die soeben fur die Bilder- 
fassungseinheit vorgeschlagen wurden, konnen auch 
stattdessen die Bezugsmittel positioniert werden. In die- 
sem Fall ist die Bilderfassungseinheit getrennt von der 
bewegbaren Einrichtung vorzugsweise ortsfest anzu- 
bringen. 

[0023] ErfindungsgemaB kann auch ein System be- 

wegbarer Einrichtungen, insbesondere verfahrbare Ro- 
boter, real isiert werden, bei welchem sich die bewegba- 
ren Einrichtungen respektive die Roboter z. B. an einer 
Vielzahl von unterschiedlichen Bezugsmittein orientie- 
ren oder uber mehrere verteilt angeordnete Bilderfas- 
sungseinheiten gesteuert werden. 
Der Einsatz der oben beschriebenen Vorrichtung zur Er- 
mittlung von korrigierten Bewegungsdatenfiireinen Be- 
wegungsablauf einer bewegbaren Einrichtung ist je- 
doch nicht notwendigerweise auf beispielhaft genannte 
verfahrbare Roboter beschrankt. Eine solche Vorrich- 
tung kann auch zur Bewegungsdatenkorrektur von Li- 
nearachsen oder automatischen Schwerlastkranen 
zum Einsatz kommen. Hierdurch lassen sich beispiels- 
weise Positioniertoleranzen, die durch die notwendige 
mechanische Elastizitat solcher Einrichtungen an sich 
nicht vermeidbar sind, korrigieren. 

Zeichnungen 

[0024] Ein Ausfuhrungsbeispiel der Erfindung ist in 
den Zeichnungen dargestellt und unter Angabeweiterer 
Vorteile und Einzelheiten naher eriautert. 
[0025] Es zeigen 

Figur 1 einen verfahrbaren Roboter an einer Halte- 

station mit einem Bezugskorper in einer 
schematischen raumlichen Darstellung und 

Figur 2 eine Teilansicht des Roboters mit Bezugskor- 
per von schrag unten. 



Beschreibung des Ausfuhrungsbeispiels 

[0026] In Figur 1 ist ein verfahrbarer Roboter 1 vor ei- 
ner Haltestation 2 dargestellt. Der verfahrbare Roboter 

5 umfasst ein fahrerloses Transportfahrzeug 3, auf dem 
ein 6-Achs-Knickarmmanipulater 4 angeordnet ist. Am 
vorderen Ende des Knickarmmanipulators 4 ist ein 
Werkzeug 5 angebracht, mit welchem Werkstucke 6 
aufgenommen werden konnen, die an der Haltestation 

10 2 auf an einer Wand 7 angebrachten Stangen 8 ab- 
nehmbar gelagert sind. 

[0027] Am oberen Rand der Wand 7 ist ein winkelfor- 

miger Bezugskorper 9 mit Markierungen 1 0 (vgl. hierzu 
Figur 2) positioniert. Am Werkzeug 5 ist eine Digitalka- 

15 mera 11 montiert. 

[0028] Das fahrerlose Transportfahrzeug 3 kann z. B. 
durch induktive Leiteinrichtungen (nicht dargestellt) 
grob vor der Haltestation 2 positioniert werden. An der 
Haltestation 2 wird uber die digitale Kamera 1 1 ein Bild 

20 vom Bezugskorper 10 aufgenommen. In der nicht dar- 
gestellten Rechnereinheit wird aus den Daten des auf- 
genommenen Bildes des Bezugskorpers 10 und Daten 
eines Bezugsbildes der Bezugsmittel, bei dem das 
Werkzeug 5 eine eingelernte Bewegung entsprechend 

25 von in der Rechnereinheit abgelegten Urbewegungsda- 
ten ausfuhren wurde, eine Transformationsvorschrift 
zurKorrekturder Urbewegungsdaten errechnet. Bei der 
Anwendung dieser Transformationsvorschrift auf die 
Urbewegungsdaten erhalt man korrigierte Bewegungs- 

30 daten, durch die dann ein eingelernter Bewegungsab- 
lauf ideal ausgefuhrt wird. 

[0029] Durch die Markierungen 12 auf dem Bezugs- 
korper 9 besitzt der Bezugskorper in einem bestimmten 
Raumwinkelbereich eindeutig zuordenbare Bildansich- 

35 ten. Dies eriaubt dem nicht dargestellten Rechner, aus 
dem aktuellen Bild des Bezugskorpers 9 nach einer gro- 
ben Positionierung des verfahrbaren Roboters Daten zu 
gewinnen, die eindeutig zu Daten eines Bezugsbildes 
in Bezug gesetzt werden konnen, um hieraus dieTrans- 

40 formationsvorschrift fur die Urbewegungsdaten zu er- 
halten. Vorzugsweise wird zur Transformation ein Ver- 
schiebungsvektor in einem dreidimensionalen recht- 
winkligen Koordinatensystem ermittelt sowie drei Win- 
keldrehungen um die Koordinatenachsen, welche das 

45 Koordinatensystem aufspannen. 

[0030] Mit dieser Kenntnis kann das Werkzeug 5 in 
unterschiedlichen Positionen des fahrerlosen Trans- 
portfahrzeugs uber den Manipulator4 durch einejeweils 
fiir eine Position des fahrerlosen Transportfahrzeugs 

50 neu zu errechnende Transformationsvorschrift die 
Werkstucke 6 an der Wand 7 anfahren, gegebenenfalls 
aufnehmen und falls gewunscht, auf einem vorbereite- 
ten Transportbereich 12 neben dem Manipulator 4 am 
fahrerlosen Transportfahrzeug 3, z. B. auf einer nicht 

55 dargestellten Palette, ablegen. Dabei werden die Bewe- 
gungen, die das Werkzeug 5 am Manipulator 4 ausiibt, 
immerdurch den Verschiebungsvektor und die drei Win- 
keldrehungen korrigiert, womit sie letztendlich mit Be- 



4 



7 



EP 1 172 183 A2 



8 



wegungen ubereinstimmen, die in der Stellung, in wel- 
cher das Bezugsbild aufgenommen wurde, dem Robo- 
ter eingelernt worden sind. 

[0031] Durch die Ernnittlung einer Transfomnations- 

vorschrift im dreidimensionalen Raum durch lediglich 
die Aufnahme eines einzigen Bildes nnittels eines opti- 
schen Erfassungssystems, das z. B. starr an einenn 
Werkzeug oder Manipulator angebracht sein kann, ist 
der korrigierte Bewegungsablauf nicht durch mechani- 
sche Wiederholungenauigkeiten belastet, die dann auf- 
treten, wenn beispielsweise entsprechend der DE 32 46 
828 C2 der Manipulator zur Positionserfassung einen 
Taststiftgegebenenfalls dreimal an Referenzpunkte be- 
wegen muss oder ein optisches System drei Referenz- 
punkte anzufahren hat. 

[0032] Die Genauigkeit des korrigierten Bewegungs- 
ablaufs durch die erfindungsgema3e Vorgehensweise 
kann noch weiterverbessertwerden, indemwahrend ei- 
nes Bewegungsablaufs des Manipulators (z. B. wah- 
rend ein Bearbeitungswerkzeug uber das Werkzeug 5 
des Manipulators 4 an einer Bearbeitungsmaschine an- 
gebracht werden soil) die Bilderfassungseinheit 11 Auf- 
nahmen vom Anbringungsort des Bearbeitungswerk- 
zeugs macht, dessen Daten mit den Daten eines be- 
kannten Bildes vergleicht, bei welchem die Bewegungs- 
bahn zum Anbringungsort exakt bekannt ist und gege- 
benenfalls daraufhin vom Rechner nochmals eine Posi- 
tionskorrektur vorgenommen wird, falls aus den Daten 
des aktuellen Bildes und den Daten des Bezugsbildes 
Abweichungen errech net werden. 
[0033] Durch den Einsatz einer Bilderfassungseinheit 
z. B. in Form einer digitalen Kamera ist das System auch 
in der Lage, eine Objekterkennung auszufuhren, wo- 
durch die erfindungsgemaBe Korrigiervorrichtung ei- 
nem zusatzlichen Verwendungszweck zugefuhrt wird. 
Normalerweise muss zur Bereitstellung einer Objekter- 
kennung ein zusatzliches optisches System am Roboter 
vorgesehen werden, was die Anfalligkeit des Systems 
erhoht und letztendlich die Kosten in die Hohe treibt. 

Bez u gszeich en I iste : 

[0034] 

1 verfahrbarer Roboter 

2 Haltestation 

3 fahrerloses Transportfahrzeug 

4 Manipulator 

5 Werkzeug 

6 Werkstiick 

7 Wand 

8 Stange 

9 Bezugskorper 

10 Markierung 

1 1 Digitalkamera 

12 Transportbereich 



Patentanspruche 

1. Vorrichtung zur Ernnittlung von korrigierten Bewe- 
gungsdaten fur einen vorgegebenen Bewegungs- 

5 ablauf einer bewegbaren Einrichtung (5) nach einer 

von einer Steuerung der bewegbaren Einrichtung 
nicht Oder nicht ausreichend erfassten Bewegung 
der bewegbaren Einrichtung (5), dadurch gekenn- 
zeichnet, dass eine Bilderfassungseinheit (1 1 ) und 

10 eine Rechnereinheit vorgesehen sind, und die 
Rechnereinheit nach der von der Steuerung der be- 
wegbaren Einrichtung nicht oder nicht ausreichend 
erfassten Bewegung korrigierte Bewegungsdaten 
mit Hilfe von Bezugsmittein (9) bestimmt, die we- 

15 nigstens in einem vorgegebenen Raumwinkelbe- 
reich eindeutig zuordenbare Bildansichten aufwei- 
sen, indem die Rechnereinheit aus Daten von ei- 
nem durch die Bilderfassungseinheit (11) aufge- 
nommenen Ist-Bild der Bezugsmittel (9) im positio- 

20 nierten Zustand der bewegbaren Einrichtung (5) 
nach der nicht oder unzureichend erfassten Bewe- 
gung und Daten eines Bezugsbildes der Bezugs- 
mittel (9), bei dem die bewegbare Einrichtung eine 
gewunschte Bewegung entsprechend von in der 

25 Rechnereinheit abgelegten Urbewegungsdaten 
ausfuhren wurde, eine Transformationsvorschrift 
zur Korrektur der Urbewegungsdaten errechnet. 

2. Vorrichtung nach Anspruch 1, dadurch gekenn- 
30 zeichnet, dass die Bilderfassungseinheit eine Ka- 
mera Oder eine Videokamera (11) umfasst. 

3. Vorrichtung nach Anspruch 1 oder 2, dadurch ge- 
kennzeichnet, dass die Rechnereinheit ein han- 

35 delsublicher PC ist. 

4. Vorrichtung nach einem der vorhergehenden An- 
spruche, dadurch gekennzeichnet, dass die 

Rechnereinheit dazu ausgelegt ist, dieTransforma- 
40 tionsvorschrift durch einen Pixel-Vergleich des Ist- 
Bildes mit dem Bezugsbild zu bestimmen. 

5. Vorrichtung nach einem der vorhergehenden An- 
spruche, dadurch gekennzeichnet, dass die 

45 Rechnereinheit zur Ermittlung einer Transformati- 
onsvorschrift in Fomn eines Verschiebungsvektors 
in einem dreidimensionalen Koordinatensystem so- 
wie von Winkeldrehungen um die drei Koordinaten- 
achsen ausgelegt ist, die das Koordinatensystem 

50 aufspannen. 

6. Anordnung zur Ermittlung von korrigierten Bewe- 
gungsdaten fiir einen Bewegungsablauf einer be- 
wegbaren Einrichtung (5) mit einer Vorrichtung 

55 nach einem der vorhergehenden Anspriiche sowie 
mit Bezugsmittel (9), die wenigstens in einem vor- 
gegebenen Raumwinkelbereich eindeutig zuorden- 
bare Bildansichten aufweisen. 
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7. Anordnung nach Anspruch 6, dadurch gekenn- 
zeichnet, dass die Bezugsmittel ein dreidimensio- 
nales Objekt mit Orientierungselementen oder des- 
sen virtuelles Bild umfassen. 

5 

8. Anordnung nach Anspruch 6 oder 7, dadurch ge- 
kennzeichnet, dass die Bezugsmittel (9) an der 
bewegbaren Einrichtung (5) und die Bilderfas- 
sungseinheit (11) getrennt von der bewegbaren 
Einriclitung (5) angeordnet ist. io 

9. Anordnung nacli einenn der vorliergelienden An- 
spruche 6 bis 8, dadurch gekennzeichnet, dass 

die 

Bilderfassungseinheit (11) an der bewegbaren Ein- 15 
riclitung (5) und die Bezugsmittel (9) getrennt von 
der bewegbaren Einrichtung (5) angeordnet sind. 

10. Bewegbare Einrichtung, insbesondere verfahrbare 
Roboter mit einem fahrerlosen Transportfahrzeug 20 
(3) und einem am Transportfahrzeug angebrachten 
Manipulator (4), dadurch gekennzeichnet, dass 

zur Ermittlung von korrigierten Bewegungsdatenfur 
die bewegbare Einrichtung (5) nach einer von der 
Steuerung der bewegbaren Einrichtung nicht oder 25 
nicht ausreichend erfassten Bewegung eine Vor- 
richtung nach einem der Anspruche 1 bis 5 vorge- 
sehen ist. 

11. Bewegbare Einrichtung nach Anspruch 10, da- 30 
durch gekennzeichnet, dass die Bezugsmittel (9) 

an der bewegbaren Einrichtung (5) angeordnet 
sind. 

12. Bewegbare Einrichtung nach Anspruch 10 Oder 11 , 35 
dadurch gekennzeichnet, dass die Bilderfas- 
sungseinheit (11) an der bewegbaren Einrichtung 

(5) angeordnet ist. 

13. System aus mehreren bewegbaren Einrichtungen, 40 
insbesondere verfahrbaren Robotern, gemaB ei- 
nem der Anspruche 10 bis 11 sowie mehreren Be- 
zugsmittel (9) Oder Bilderfassungseinheiten (11). 

45 



50 
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